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[57] ABSTRACT 

A method and apparatus to control a robot or manipula- 
tor configuration over the entire motion based on aug- 
mentation of the manipulator forward kinematics. A set 
of kinematic functions is defined in Cartesian or joint 
space to reflect the desirable configuration that will be 
achieved in addition to the specified end-effector mo- 
tion. The user-defined kinematic functions and the end- 
effector Cartesian coordinates are combined to form a 
set of task-related configuration variables as generalized 
coordinates for the manipulator. A task-based adaptive 
scheme is then utilized to directly control the configura- 
tion variables so as to achieve tracking of some desired 
reference trajectories throughout the robot motion. 
This accomplishes the basic task of desired end-effector 
motion, while utilizing the redundancy to achieve any 
additional task through the desired time variation of the 
kinematic functions. The present invention can also be 
used for optimization of any kinematic objective func- 
tion, or for satisfaction of a set of kinematic inequality 
constraints, as in an obstacle avoidance problem. In 
contrast to pseudoinverse-based methods, the configu- 
ration control scheme ensures cyclic motion of the ma- 
nipulator, which is an essential requirement for repeti- 
tive operations. The control law is simple and computa- 
tionally very fast, and does not require either the com- 
plex manipulator dynamic model or the complicated 
inverse kinematic transformation. The configuration 
control scheme can alternatively be implemented in 
joint space. 

20 Claims, 8 Drawing Sheets 
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METHOD AND APPARATUS FOR 
CONFIGURATION CONTROL OF REDUNDANT 
ROBOTS 

5 

ORIGIN OF INVENTION 

The invention described herein was made in the per- 
formance of work under a NASA contract, and is sub- 
ject to the provisions of Public Law 96-517 (35 USC 
202) in which the Contractor has elected not to retain 
title. 


TECHNICAL FIELD 

The present invention relates generally to robotics 
and more specifically to a method and apparatus for 
configuration control of robots having redundant joints 
by defining task-related kinematic functions and com- 
bining them with end-effector coordinates to form a set 
of configuration variables which reflects one or more 2Q 
additional tasks that will be performed due to the redun- 
dancy. 

BACKGROUND ART 

The remarkable dexterity and versatility that the 25 
human arm exhibits in performing various tasks can be 
attributed largely to the kinematic redundancy of the 
arm, which provides the capability of reconfiguring the 
arm without affecting the hand position. A robotic ma- 
nipulator is called (kinematically) “redundant” if it pos- 30 
sesses more degrees of freedom (DOF) than is necessary 
for performing a specified task. Redundancy of a ro- 
botic manipulator is therefore determined relative to the 
particular task to be performed. For example, in the 
two-dimensional space, a planar robot with three joints 35 
is redundant for achieving any end-effector position; 
whereas the robot is non-redundant for tasks involving 
both position and orientation of the end-effector. In the 
three-dimensional space, a manipulator with seven or 
more joints is redundant because six degrees of freedom 40 
are sufficient to position and orient the end-effector in 
any desired configuration. In a non-redundant manipu- 
lator, a given position and orientation of the end-effec- 
tor corresponds to a limited set of joint angles and asso- 
ciated robot configurations with distinct poses (such as 45 
elbow up or down). Therefore, for a prescribed end- 
effector trajectory and a given pose, the motion of the 
robot is uniquely determined. When this motion is unde- 
sirable due to collision with obstacles, approaching 
kinematic singularities, or reaching joint limits, there is 50 
no freedom to reconfigure the robot so as to reach 
around the obstacles, or avoid the singularities and joint 
limits. 

Redundancy in the manipulator structure yields in- 
creased dexterity and versatility for performing a task 55 
due to the infinite number of joint motions which result 
in the same end-effector trajectory. However, this rich- 
ness in choice of joint motions complicates the manipu- 
lator control problem considerably. In order to take full 
advantage of the capabilities of redundant manipulators, 60 
effective control schemes should be developed to utilize 
the redundancy in some useful manner. During recent 
years, redundant manipulators have been the subject of 
considerable research, and in the following references 
several methods have been suggested to resolve the 65 
redundancy: 

1 D. E. Whitney, “Resolved motion rate control of 

manipulators and human prostheses,” IEEE Trans. 


2 

Man-Machine Syst., vol. MMS-10, no. 2, pp. 47-53, 
1969. 

2. A. Liegeois, “Automatic supervisory control of the 
configuration and behavior of multibody mecha- 
nisms,” IEEE Trans. System, Man Cybern., vol. 
SMC-7, no. 12, pp. 868-871, 1977. 

3. H. Hanafusa, T. Yoshikawa, and Y. Nakamura, 
“Analysis and control of articulated robot arms with 
redundancy,” in Proc. 8th IFAC Triennial World 
Congress (Kyoto, Japan, 1981) pp. 1927-1932. 

4. T. Yoshikawa, “Analysis and control of robot manip- 
ulator with redundancy,” in Proc. 1st Int. Symp. on 
Robotics Research (Bretton Woods, NH, 1983), pp. 
735-747. 

5. Y. Nakamura and H. Hanafusa, “Task priority based 
redundancy control of robot manipulators,” in Proc. 
2nd Int. Symp. on Robotics Research (Kyoto, Japan, 
August 1984). 

6. T. Yoshikawa, “Manipulability and redundancy con- 
trol of robotic mechanisms,” in Proc. IEEE Int. 
Conf. on Robotics and Automation (St. Louis, Mo., 
March 1985), pp. 1004-1009. 

7. J. Baillieul, J. Hollerbach, and R. Brockett, “Pro- 
gramming and control of kinematically redundant 
manipulators,” in Proc. 23rd IEEE Conf. on Decision 
and Control, pp. 768-774, December 1984. 

8. J. Baillieul, “Kinematic programming alternatives for 
redundant manipulators,” in Proc. IEEE Int. Conf. 
on Robotics and Automation (St. Louis, Mo., March 
1985), pp. 772-728. 

9. , “Avoiding obstacles and resolving kine- 

matic redundancy,” in Proc. IEEE Int. Conf. on 
Robotics and Automation (San Francisco, Calif., 
April 1986), pp. 1698-1704. 

10. J. Baillieul, R. Brockett, J. Hollerbach, D. Martin, 
R. Percy, and R. Thomas, “Kinematically redundant 
robot manipulators,” in Proc. NASA Workshop on 
Space Telerobotics (Pasadena, Calif.,), vol. 2, pp. 
245-255, January 1987. 

11. J. Baillieul, “Design of kinematically redundant 
mechanisms,” in Proc. 24th IEEE Conf. on Decision 
and Control (Ft. Lauderdale, Fla., December 1985), 

pp. 18-21. 

12. I. D. Walker and S. I. Marcus, “An approach to the 
control of kinematically redundant robot manipula- 
tors,” in Proc. American Control Conf. (Seattle, 
Wash., June 1986), pp. 1907-1912. 

13. C. A. Klein and C. H. Huang, “Review of pseudoin- 
verse control for use with kinematically redundant 
manipulators,” IEEE Trans. System, Man Cybern., 
vol. SMC-13, no. 3, pp. 245-250, 1983. 

14. S. Y. Oh, D. Orin, and M. Bach, “An inverse kine- 
matic solution for kinematically redundant robot 
manipulators,” J. Robotic Syst., vol. 1, no. 3, pp. 
235-249, 1984. 

15. S. Y. Oh, “Inverse kinematic control for redundant 
manipulators,” in Proc. IEEE Workshop on Intelli- 
gent Control (Troy, N.Y., 1985), pp. 53-57. 

16. O. Khatib, “A unified approach for motion and 
force control of robot manipulators: The operational 
space formulation,” IEEE J. Robotics Automat., vol. 
RA-3, no. 1, pp. 43-53, 1987. 

17. C. A. Klein, “Use of redundancy in the design of 
robotic systems,” in Proc. 2nd Int. Symp. on Robot- 
ics Research (Kyoto, Japan, August 1984). 

18. A. A. Maciejewski and C. A. Klein, “Obstacle 
avoidance for kinematically redundant manipulators 
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in dynamically varying environments,” Int. J. Robot- 
ics Res., vol. 4, no. 3, pp. 109-117. 1985. 

19. C. A Klein and A. I. Chirco, “Dynamic simulation 

of a kinematically redundant manipulator system,” J. 
Robotic Syst., vol, 4, no. 1, pp. 5-23, 1987. 5 

20. D. R. Baker and C. W. Wampler, “Some facts con- 

cerning the inverse kinematics of redundant manipu- 
lators,” in Proc. IEEE Int. Conf. on Robotics and 
Automation (Raleigh, N.C., March 1987). pp. 
604-609. 10 

21. J. M. Hollerbach, “Optimum kinematic design for a 
seven degree of freedom manipulator,” in Proc. 2nd 
Int. Symp. on Robotics Research (Kyoto, Japan, 
August 1984). 

22. J. M. Hollerbach and K. C. Suh, “Redundancy 15 
resolution of manipulators through torque optimiza- 
tion,” in Proc. IEEE Int. Conf. on Robotics and 
Automation (St. Louis, Mo., March 1985), pp. 
1016-1021. 

23. O. Egeland, “Cartesian control of a hydraulic re- 20 
dundant manipulator,” in Proc. IEEE Int. Conf. on 
Robotics and Automation (Raleigh, N.C., April 
1987), pp. 2081-2086. 

24. L. Sciavicco and B. Siciliano, “A dynamic solution ^ 
to the inverse kinematic problem for redundant ma- 
nipulators,” in Proc. IEEE Int. Conf. on Robotics 
and Automation (Raleigh, N.C., April 1987), pp. 
1081-1087. 

25. P. Hsu, J. hauser, and S. Sastry, “Dynamic control 3Q 
of redundant manipulators,” in Proc. IEEE Int. Conf. 
on Robotics and Automation (Philadelphia, Pa., 
April 1988), pp. 183-187. 

26. R. V. Dubey, J. A, Euler, and S. M. Babcock, “An 
efficient gradient projection optimization scheme for 35 
a 7 dof redundant robot with spherical wrist,” in 
Proc. IEEE Int. Conf. on Robotics and Automation 
(Philadelphia, Pa., April 1988), pp. 28-36. 

Whitney [ljsuggests the use of Jacobian pseudoin- 
verse for the control of redundant manipulators. Lie- 40 
geois [2]proposes a modification to the pseudoinverse 
approach to resolve manipulator redundancy. 
Nakamura and Yoshikawa [3]-[6] develop a scheme 
based on task priority using pseudoinverses. Baillieul 
[7]-[l 1] proposes the extended Jacobian method to min- 45 
imize or maximize an objective function. Walker and 
Marcus [12] suggest a method based on the pseudoin- 
verse approach to impose a constraint relationship on 
the manipulator. A comprehensive review of the pseu- 
doinverse approach to redundant manipulators is given 50 
by Klein and Huang [13]. Oh, Orin, and Bach [14], [15] 
describe a numerical procedure for solving the inverse 
kinematic problem which uses constraints on the manip- 
ulator. Khatib [16] gives a method for the resolution of 
redundancy using the robot dynamics in the operational 55 
space. Klein [17]— [19] addresses obstacle avoidance and 
dynamic simulation of redundant robots. Baker and 
Wampler [20] study the kinematic properties of redun- 
dant manipulators. The problems of robot design and 
torque optimization are addressed by Hollerbach [21], 60 
[22]. Egeland [23] describes a method for Cartesian 
control of a hydraulic redundant manipulator. Scia- 
vicco and Siciliano [24] give dynamic solution to the 
inverse kinematic problem for redundant robots. Hsu, 

* Hauser, and Sastry [25] discuss the resolution of redun- 65 
dancy using the manipulator dynamics. Dubey, Euler, 
and Babcock [26] describe a gradient projection optimi- 
zation scheme for 7-DOF robots. 
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Over the past two decades, investigations of redun- 
dant manipulators have often been explicitly or implic- 
itly based on the Jacobian pseudoinverse approach for 
the utilization of redundancy through local optimiza- 
tion of some objective function. Furthermore, most 
proposed methods resolve the redundancy in joint 
space and are concerned solely with solving the inverse 
kinematic problem for redundant manipulators. 

U.S. Pat. No. 4,860,215 issued Aug. 22, 1988 to the 
inventor herein, discloses related subject matter and 
background prior art. U.S. Pat. Nos. 4,685,054; 
4,621,332; 4,794,547; and 4,641,251 also disclose rele- 
vant, but distinguishable subject matter. 

SUMMARY OF THE INVENTION 

In the present invention, a new and conceptually 
simple approach to configuration control of redundant 
manipulators constitutes a complete departure from the 
conventional pseudoinverse methods. In this approach, 
the redundancy is utilized for control of the manipula- 
tor configuration directly in task space, where the task 
is performed; thus avoiding the complicated inverse 
kinematic transformation. A set of kinematic functions 
in Cartesian or joint space is chosen to reflect the de- 
sired additional task that will be performed due to the 
redundancy. The kinematic functions can be viewed as 
parameterization of the manipulator “self-motion,” in 
which the internal movement of the links does not move 
the end-effector. In other words, given the end-effector 
position and orientation, the kinematic functions are 
used to “shape” the manipulator configuration. The 
end-effector Cartesian coordinates and the kinematic 
functions are combined to form a set of “configuration 
variables” which describe the physical configuration of 
the entire manipulator in the task space. The control 
scheme then ensures that the configuration variables 
track some desired trajectories as closely as possible, so 
that the manipulator motion meets the task require- 
ments. The control law is adaptive and does not require 
knowledge of the complex dynamic model or parameter 
values of the manipulator or payload. The scheme can 
be implemented in either a centralized or a decentral- 
ized control structure, and is computationally very fast, 
making it specially suitable for real-time control of re- 
dundant manipulators. 

OBJECTS OF THE INVENTION 

It is therefore a principal object of the present inven- 
tion to provide an apparatus and method for configura- 
tion control of redundant robots or manipulators. 

It is an additional object of the present invention to 
provide an apparatus and method for achieving trajec- 
tory tracking for the end-effector of a redundant robot 
or a manipulator directly in the Cartesian space to per- 
form a desired task while simultaneously imposing a set 
of kinematic constraints to accomplish an appropriate 
additional task. 

It is still an additional object of the present invention 
to provide an apparatus and method implemented with 
a redundant robot real-time control scheme which re- 
solves the redundancy at the task level to provide direct 
control over the entire motion and which produces a 
cyclical end configuration. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The aforementioned objects and advantages of the 
present, as well as additional objects and advantages 
thereof, will be more fully understood hereinafter as a 
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result of a detailed description of a preferred embodi- 
ment when taken in conjunction with the following 
drawings in which: 

FIG. 1 is a graphical illustration of a planar three-link 
arm; 5 

FIG. 2 is a schematic illustration of a seven degree of 
freedom arm; 

FIG. 3 is a block diagram representation of the archi- 
tecture of the configuration control scheme of the pres- 
ent invention; 10 

FIG. 4 is a block diagram representation of the cen- 
tralized adaptive control law in the task space as used in 
the invention; 

FIG. 5 is a functional block diagram of a testbed 
facility in which the present invention has been tested; l 5 

FIG. 6 is a graphical two-dimensional illustration of a 
robot’s 3-link arm employed in the testbed facility of 
FIG. 5; 

FIG. 7 is a block diagram of the inventive configura- 
tion control scheme employed in the robot arm of FIG. 20 

6; 

FIGS. 8-10 are respective graphical representations 
of time response characteristics of the robot arm of 
FIG. 6 when the shoulder angle thereof is controlled 
using the control technique of the invention; and 25 

FIGS. 11-13 are respective graphical representations 
of time response characteristics of the robot arm of 
FIG. 6 when the wrist height thereof is controlled using 
the control technique of the present invention. 

30 

DETAILED DESCRIPTION OF A PREFERRED 
EMBODIMENT 

I. The Robot 

The mechanical manipulator under consideration 
consists of a linkage of rigid bodies with n re volute or 35 
prismatic joints. Let T be the n X 1 vector of torques or 
forces applied at the joints and 6 be the n X 1 vector of 
the resulting relative joint rotations or translations. The 
dynamic equation of motion of the manipulator which 
relates T to 0 can be represented in the general form 40 

M(0)V+N(ej)=T ( 1 ) 

where the matrices M and N are highly complex non- 
linear functions of and the payload. Let the m X 1 vector 45 
Y (with m<n) represent the position and orientation of 
the end-effector (last link) with respect to a fixed Carte- 
sian coordinate system in the m-dimensional task space 
where the task is to be performed. The m X 1 end-effec- 
tor coordinate vector Y is related to the n X 1 joint angle 50 
vector 0 by the forward kinematic model 

r= Y(6) (2) 

where Y(0) is an mX 1 vector whose elements are non- 55 
linear functions of the joint angles and link parameters, 
and which embodies the geometry of the manipulator. 
For a redundant manipulator, a Cartesian coordinate 
vector (such as Y) that specifies the end-effector posi- 
tion and orientation does not constitute a set of general- 60 
ized coordinates to completely describe the manipulator 
dynamics. Nonetheless, equations (1) and (2) form a 
valid dynamic model that describes the end-effector 
motion itself in the task space. The desired motion of the 
end-effector is represented by the reference position 65 
and orientation trajectories denoted by the m X 1 vector 
Y<* (t), where the elements of Yd (t) are continuous 
twice-differential functions of time. The vector Yd (t) 
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embodies the information on the “basic task” to be 
accomplished by the end-effector in the task space. 

We now discuss the definition of configuration vari- 
ables and the task-based control of redundant manipula- 
tors. 

II. Definition of Configuration Variables 

Let r— n — m be the “degree-of-redundancy“ of the 
manipulator, i.e., the number of “extra” joints. Let us 
define a set of r kinematic functions {(f>i(0), <J> 2 ( 0 ), 

<f) r (0)} in Cartesian or joint space to reflect the “addi- 
tional task'’ that will be performed due to the manipula- 
tor redundancy. Each (f>/ can be a function of the joint 
angles {$\ r •• • » ®n} and the link geometric parameters. 
The choice of kinematic functions can be made in sev- 
eral ways to represent, for instance, the Cartesian coor- 
dinates of any point on the manipulator, or any combi- 
nation of the joint angles. The kinematic functions pa- 
rameterize the “self-motion” of the manipulator, in 
which the internal movement of the links does not move 
the end-effector. 

For illustration, consider the planar three-link arm 
shown in FIG. I. The basic task is to control the end- 
effector position coordinates [x, y]in the base frame. 
Suppose that we fix the end-effector position and allow 
internal motion of the links so that the arm takes all 
possible configurations. It is found that the locus of 
point A is an arc of a circle with center O and radius 1/ 
which satisfies the distance constraint AC = (b-S- I 3 )* 
Likewise, the locus of point B is an arc of a circle with 
center C and radius I 3 which satisfies OB = (I 1 + I 2 ) 
The loci of A and B are shown by solid arcs in FIG. 
1(a), and represent the self-motion of the arm. Now in 
order to characterize the self-motion, we can select a 
kinematic function <f>(0) to represent, for instance, the 
terminal angle <f> = &3 in joint space, or alternatively we 
can designate the wrist height y^as the kinematic func- 
tion <J>=li sin #i-f I 2 sin 0 2 in Cartesian space. The 
choice of 0 clearly depends on the particular task that 
we wish to perform by the utilization of redundancy, in 
addition to the end-effector motion. Let us now con- 
sider the spacial 7-DOF arm [21] shown in FIG. 2, in 
which the end-effector position and orientation are of 
concern. With the end-effector frame fixed in space, the 
self-motion of the arm consists of the elbow transcribing 
a circle with center C and radius CA, as shown in FIG. 
2. This circle is the intersection of a sphere with center 
O and radius OA, and another sphere with center B and 
radius BA. In order to parameterize the self-motion, we 
can now define the kinematic function 4> (0) = a, where 
a is the angle between the plane OAB and the vertical 
plane passing through OB, as shown in FIG. 2. The 
kinematic function <f> then succinctly describes the re- 
dundancy and gives a simple characterization of the 
self-motion. 

Once a set or r task-related kinematic functions 
<t> = $ 2 , . . . , 4> r ) is defined, we have a partial infor- 

mation on the manipulator configuration. The set of m 
end-effector position and orientation coordinates Y = - 
{y 1 , y 2 , . . . , y m } provides the remaining information on 
the configuration. Let us now combine the two sets <t> 
and Y to obtain a complete set of n configuration vari- 
ables as 



7 


4,999,553 


x = {y.<t>} 


yun* — ym -4n. <f>2 <f>r 


(3) 


= {x\, x 2 x n y. 


The n X 1 vector X is referred to as the “configuration 
vector” of the redundant manipulator and the elements 
of X, namely {xi, . . . , x„}, are called the “configuration 
variables.” The configuration variables define an n- 
dimensional “task space” whose coordinate axes are 
{xj, X 2 , . . . , x„}. The task space is composed of two 
subspaces; namely, the m-dimensional end-effector sub- 
space with axes {xj, . . . , x m } and the r-dimensional 
subspace due to kinematic functions with axes {x m +i, . 
. . , x„}. The configuration variables {xj, . . . , x„} consti- 
tute a set of generalized coordinates for the redundant 
manipulator in a given region of the workspace. Using 
the configuration vector X, the manipulator is fully 
specified kinematically and is no longer redundant in 


Jc 


this representation. It is noted that in some applications, 
certain end-effector coordinates are not relevant to the 
task, for instance, in a spot welding task the orientation 
of the end-effector is not important. In such cases, the 
present approach allows the designer to replace the 
insignificant end-effector coordinates with additional 
kinematic functions which are more relevant to the 
particular application. In fact, if m' (<m) end-effector 
coordinates are specified, then n — m' = r'(>r) kinematic 
functions can be defined. 

The augmented forward kinematic model which re- 
lates the configuration vector X to the joint angle vec- 
tor 0 is now given by 


X 




( 4 ) 


= *(0). 


From (4), the differential kinematic model which relates 
the rates of change of X and 0 is obtained as 


xu) « Aemo 

where 


(5) 


m = 


(Me) \ 

f ar ^ 

id 

J 

0<S> 

l * ; 


( 6 ) 


is the nXn augmented Jacobian matrix. The mXn sub- 
matrix J e (0)= a Y/d6 is associated with the end-effector, 
while the r X n submatrix J c ( 0)= 3<t>/d0 is related to the 
kinematic functions. The combination of the two non- 
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square submatrices J c and J c forms the square Jacobian 
matrix J. 

The augmented Jacobian matrix J can be used to test 
the functional independence of the kinematic functions 
5 . . . , 4> r } and the end-effector coordinates {yi, . . . 

, ym). For the set of configuration variables Xi ={x , . . 
. , x„} to be functionally independent through out the 
workspace, if suffices to check that det [J(0)j is not 
identically zero for all 0 . In other words, when the 
10 augmented Jacobian matrix J is rank-deficient for all 
values of 0, the kinematic functions chosen are function- 
ally dependent on the end-effector coordinates and a 
different choice of is necessary. For example, con- 
sider the three-link planar arm in FIG. 1 with the end- 
15 effector coordinates [x, y] and suppose that we define 
the end-effector distance from the origin, i.e., OC, as the 
kinematic function <J> (0), that is, 


W)=(OC) 2 -x 2 +r. 


20 


The third row of the resulting Jacobian matrix is 

(3d> 

00 1 O0 2 <J£>3 J 

dx „ * dy ~ ox - (H> - ov 

** O0\ + ^ O0\ • 002 + ~ y 00 2 ’ o0 } + “ V ’ 00} J 


= [ 2 x.2y) 


OX da 

O0\ 00 2 00} 
oy ov 0 v 
001 002 00} 


= [ 2 *. 2y)J c . 


It is seen that the third row is a linear combination of the 
first and second rows, and hence 


40 det[J) = 0 

for all 0. This implies that the particular choice of (0) 
is not independent of the end-effector coordinates, as 
45 expected, and is therefore unacceptable. 

When det [J(0)] is not identically zero, the configura- 
tion variables {xi, . . . , x„} are not functionally depen- 
dent for all 0. Nonetheless, there can be certain joint 
configurations 0 = 0o at which det [J(0o)] = O, i.e.. the 
50 augmented Jacobian matrix J is rank-deficient. This 
implies that the rows J'of J satisfy the linear relationship 


55 1 cjJ ' = 0 

/= 1 

where c* are some constants which are not all zero. 
Since the changes of the configuration variables and 
^ joint angles are related by Ax=J(0)A0, we conclude 
that at 0 = 0o 

n 

I c, Ax, = 0. 

/’= 1 

65 

Therefore, at a Jacobian singularity, the changes in the 
configuration variables {Axi, . . . , Ax,,} must satisfy the 
constraint relationship 
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n 

2 c/Ajc, = 0 
/= 1 


and hence the configuration vector X cannot 
changed arbitrarily. This also implies that 


be 


2 CjXj = 0 
/— 1 


10 


15 


20 


i.e., no combination of joint velocities will produce 
motion along certain directions in the task space. From 
equation (6), it is clear that the Jacobian matrix J will be 
singular at any joint configuration for which the subma- 
trix 5 e is rank-deficient; i.e., at any end-effector singular 
configuration. These are referred to as kinematic singu- 
larities of the manipulator. Due to the additional task 
requirements, algorithmic singularities may further be 
introduced into the Jacobian matrix J due to the subma- 
trix J c . These singularities occur when either J c is rank- 
deficient or some rows of J c and J e are linearly depen- 
dent. However, by a judicious choice of the kinematic 
functions, some algorithmic singularities may be 
avoided. Further discussion of the augmented Jacobian 25 
singularities can be found in J. Burdick and H. Seraji, 
“Characterization and control of self-motions in redun- 
dant manipulators,” in Proc. NASA Conf. on Space 
Telerobotics (Pasadena, Calif., 1989). 

For the sake of illustration, let us reconsider the pla- 
nar three-link arm shown in FIG. 1. Let x and y repre- 
sent the Cartesian coordinates of the hand (C) position 
to be controlled, and suppose that the hand orientation 
is not of concern so that the arm is redundant with the 
degree of redundancy equal to one. Suppose that we 
wish to utilize the redundancy in order to control the 
elbows (A) position or equivalently the shoulder shoul- 
der angle 0 i, in addition to the hand position. For this 
purpose, the kinematic function can be defined in a 
number of ways such as 


30 


35 


40 


<t> = 1 j sin 
— 1 1 cos 0j 
<t> = 0, 


elbow vertical position 
elbow horizontal position 
shoulder angle. 


The above choices of will serve the same purpose. 
Nonetheless, each choice of <f> will yield a different 
augmented Jacobian matrix J and hence different singu- 
lar configurations. Let us take the last choice of <f> and, 
from FIG. 1, obtain the configuration variables for the 
arm as 


50 


x = l\ cosd \ + IjcosBj -j- hcosS} 
y— l\sinB\ + fain 0o + l^sinB} 


55 


4>=0\- 

From these equations, the augmented Jacobian matrix is 


found to be 


/y„ \ 

~ — /jsin 0 j — / 2 sin 02 — / 3 sin 03 

/=H= 

/|COS 0 i / 2 COS 02 / 3 COS 03 

UJ 

1 0 0 


60 


65 


and hence 


10 

-continued 
del J = hi} stn <03 - 0 2 ). 


The singular configurations are obtained from det J = 0 
as 03 — 02 and 03 = #2+ 180°. It is seen that for our par- 
ticular choice of <f>, the arm “appears” to be a two-link 
arm (h, I 3 ) with a moveable base (A). As for any two- 
link arm, the two singular configurations are when the 
arm is either fully extended (03 = 02) or fully folded 
(03 = 02+180°). It is noted that if, instead, the elbow 
vertical or horizontal position is selected as the kine- 
matic function 4>, additional algorithmic singularities 
will be introduced at 0 1 = ±90° or 0i = 0°, 180°, respec- 
tively. Therefore, the choice of the kinematic function 
cf> is a critical factor in determining the algorithmic 
singularities of the arm. From this example, we see that 
it is preferable to choose a combination of joint angles as 
a kinematic function, if feasible, since the resulting Jaco- 
bian matrix J c will then consist of a constant row which 
does not depend on the robot configuration. Otherwise 
additional algorithmic singularities may be introduced 
due to J c . 

An alternative way to utilize the redundancy is to 
ensure avoidance of certain kinematic singularities, in 
addition to desired end-effector motion. For the three- 
link arm, the square of “manipulability measure” [6] 
associated with the end-effector can be defined as the 
kinematic function <f>, namely 


0(4>) = detWeUe'm 

= /i 2 /2“Sin 2 (02 — 0i ) + /|-/3“sin-(03 — 0j) 4- 

/2 2 /3 2 sin 2 (03 — 62 ) 


where J e (0) is the end-effector Jacobian matrix, and the 
prime denotes transposition. The function c (>(0) will be 
zero at the kinematic singularities related to the end- 
effector. In order to avoid these singularities, the redun- 
dancy is used to ensure that the manipulability measure 
<J>(0) is a non-zero constant or tracks some desired posi- 
tive time function 4>d (t). 

III. Task-Based Configuration Control 
Suppose that a user-defined “additional task” can be 
expressed by the following kinematic equality con- 
straint relationships: 


4>i (0) =<!></ 1</> 
4 > 2 ( 0 ) =4>diU) 


<M0) = M) 

where <j></Xt) denotes the desired time variation of the 
kinematic function <j>,and is a user-specified continuous 
twice-differentiable function of time so that (jv,<t) and 
<j>y,{t) are defined. The above kinematic relationships 
can be represented collectively in the vector form 

<P(0) = <P<X t) (8) 

where <I> and <Jv are rX 1 vectors. Equation (8) repre- 
sents a set of “kinematic constraints” on the manipulator 
and defines the task that will be performed in addition 
to the basic task of desired end-effector motion. The 
kinematic equality constraints (8) are chosen to have 
physical interpretations and are used to formulate the 
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desireable characteristics of the manipulator configura- 
tion in terms of motion of other members of the manipu- 
lator, The utilization of redundancy to provide direct 
control over the entire robot configuration enables the 
user to specify the evolution of the robot configuration 5 
while the end-effector is traveling a prescribed path. 
This control strategy is particularly useful for maneu- 
vering the robot in a constricted workspace or a clut- 
tered environment. Since the robot “shape” is con- 
trolled directly, it can be configured to fit within a 10 
restricted space or keep clear of workspace objects. For 
instance in the 7-DOF arm of FIG. 2, the user can en- 
sure that the arm assumes a desired angle relative to the 
vertical, when the hand reaches the goal location. Al- 
ternatively, by controlling the elbow height as well as 15 
the hand coordinates, we can ensure that the elbow 
reaches over vertical obstacles (such as walls) in the 
workspace while the hand tracks the desired trajectory. 
The proposed formulation appears to be a highly prom- 
ising approach to the additional task performance in 20 
comparison with the previous approaches which at- 
tempt to minimize or maximize objective functions, 
since we are now able to make a more specific statement 
about the evolution of the manipulator configuration. ^ 
The present approach also covers the intuitive solution 
to redundant arm control in which certain joint angles 
are held constant for a portion of the task in order to 
resolve the redundancy. The functional forms of the 
kinematic functions 4 >i an d their desired behavior 4>di 30 
may vary widely for different additional tasks, making 
the approach unrestricted to any particular type of 
application. 

Based on the foregoing formulation, we can now 
consider the manipulator with the nXi configuration 35 
vector 


X = 



40 


and the augmented forward kinematic model X = X(0). 
Once the desired motion of the end-effector Yd (t) is 
specified for the particular basic task and the required 
evolution of the kinematic functions <f>d(t) is specified to 45 
meet the desired additional task, the n X 1 desired con- 
figuration vector 


Xd(0 = 


' YdU) \ 
) 


50 


is fully determined. The configuration control problem 
for the redundant manipulator is to devise a dynamic 55 
control scheme as shown in FIG. 3 which ensures that 
the manipulator configuration vector X(t) tracks the 
desired trajectory vector X</(t) as closely as possible. In 
the control system shown in FIG. 3, the actual end- 
effector position Y(t) and the current value of the kine- 60 
matic functions <4>(t) are first computed based on the 
joint positions #(t) using the augmented forward kine- 
matic model (4). This information is then fed back to the 
controller which also receives the commanded end- 
effector motion Y^(t) and the desired time variation <f></ 65 
(t) to compute the driving torques T(t). These torques 
are applied at the manipulator joints so as to meet the 
basic and additional task requirements simultaneously. 


12 

Once the forward kinematic model of the manipula- 
tor is augmented to include the kinematic functions, 
different control strategies can be improvised to meet 
the above tracking requirement, taking into account the 
dynamics of the manipulator given by (1). There are 
two major techniques for the design of tracking control- 
lers in task space; namely, model-based control and 
adaptive control. For the model-based control [16], the 
manipulator dynamics is first expressed in task space as 

M x {6)X+N x (e, $)=F ( 9 ) 

where F is the nx 1 “virtual” control force vector in the 
task space, and M x and N v are obtained from equations 
(l)-(6). The centralized control law which achieves 
tracking through global linearization and decoupling is 
given by 

F= M x (0)[Xd{t) + K v {X d )t) - X{t)) + Kp(X d 
{t)-Xm+NJfi % '6) ( 10 ) 

where and K v are constant position and velocity 
feedback gain matrices. This control formulation re- 
quires a precise knowledge of the full dynamic model 
and parameter values of the manipulator and the pay- 
load. Furthermore, since M x and N t depend on the 
definition of the kinematic functions cf>, any change in 
the additional task specifications requires reevaluation 
of the robot dynamic model (9). The alternative ap- 
proach is the adaptive control technique in which the 
on-line adaptation of the controller gains eliminates the 
need for the complex manipulator dynamic model. In 
this section, we adopt an adaptive control scheme 
which has been validated experimentally on a PUMA 
industrial robot. The adaptive controller produces the 
control signal base on the observed performance of the 
manipulator and has therefore the capability to operate 
with minimal information on the manipulator/payload 
and to cope with unpredictable gross variations in the 
payload. 

The proposed adaptive control scheme is developed 
within the framework of Model Reference Adaptive 
Control (MRAC) theory, and the centralized adaptive 
tracking control law in the task space is 
F{t)=d{t)+ [K p {t)E{t)+K v {t)E{t)] + [ 
cm^+B^Xdi^+A^Xdit)} (in 

as shown in FIG. 4. This control force is composed of 
three components, namely: 

(i) The auxiliary signal d(t) is synthesized by the adap- 
tation scheme and improves transient performance 
while resulting in better tracking and providing more 
flexibility in the design. 

(ii) The term (K^(t)E(t) -+- K v (t)E(t)) is due to the PD 
feedback controller acting on the position tracking 
error E(t) = X<Xt) — X(t) and the velocity tracking error 
E(t)=?Ut)-£(t). 

(iii) The term (C(t)Xd(t) + B(t)X,/ (t)+ A(t)X,/ (t)) is 
the contribution of the PD 2 feedforward controller 
operating on the desired position X f / (t), the desired 
velocity X</( t), and the desired acceleration X f /(t). 

The required auxiliary signal and feedback/feedfor- 
ward controller gains are updated based on the nxl 
“weighted” error vector q(t) by the following simple 
adaptation laws: 


q(t) = IVpE(t) + W v E{t) 


(12) 
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-continued 

d(t) - d( 0 ) + 5 1 f q{t)dt + digit) 


''/o'" 

.,r 

J 0 

H/5|f 
J 0 

■M f ' * 

J 0 

nf '« 

J 0 


= Kfk 0 ) -I- cxi $(/)£*(/)<& + ai q{t)F(t) 


KM = KM + 0i qitWWdt + (hq{t)E{ty 
J 0 


C{/) = C(0) + v\ qiOX’diOdt + v 2 q(t)X , d (t) 


B(t) = 5(0) + yi <fcyCAt\dt 4- yiq(t)X<ti) 


■ A{ 0) + \i 


<*/)*•<*(/)<* + 


In (13)— (1 8), {Si, a\, fi\, v\ t y\, \\} t are any positive 
scalar integral adaptation gains, and {82, ai, kh vi> 72} 
are zero or any positive scalar proportional adaptation 
gains. In (12), W^diag, {w/>/} and W v =diag/{w w -} are 
nxn weighting matrices chosen by the designer to 25 
reflect the relative significance of the position and ve- 
locity errors E and E in forming the vector q. The 
values of the adaptation gains and weighting matrices 
determine the rate at which the tracking errors con- 
verge to zero. 30 

Since the control actuation is at the manipulator 
joints, the control force F is implemented as the joint 
torque T where 

m=ne)m <i 9 ) 35 

The augmented Jacobian matrix J(0) is used in (19) to 
map the task-space forces F(t) to the joint-space torques 
T(t). Equation (19) represents the fundamental relation- 
ship between the task and joint spaces and is the basis 40 
for implementation of any task-based control scheme. 
Equation (19) can be rewritten as 


~FM “j 45 

no = = sm)fm + sdWFM 

FJ0 


where F e and F c are the mX 1 and rx 1 control force 
vectors corresponding to the basic task and the addi- 50 
tional task, respectively. It is seen that the total control 
torque is the sum of two components: T e =J e F e due to 
the end-effector motion (basic task) and T C =J C ' due to 
the kinematic constraints (additional task). Equation 
(20) shows distinctly the contributions of the basic and 55 
the additional tasks to the overall control torque. Under 
the joint control law (20), the desired end-effector tra- 
jectory Yd (t) is tracked, and the “extra” degrees of 
freedom are appropriately used to control the evolution 
of the manipulator configuration through tracking of 60 
the desired functions <f>d (t). In other words, the self- 
motion of the manipulator is controlled by first charac- 
terizing this motion in terms of user-defined kinematic 
functions and then controlling these functions through 
trajectory tracking. 65 

In the foregoing centralized adaptive controller (11), 
each task-space control force F/is generated on the basis 
of all configuration variables (xj, . . . , x n }. The control- 


ler complexity and computations can be reduced signifi- 
cantly if the adaptive control scheme is implemented in 
a decentralized control structure. In this case, each 
task-space control force F/ is responsible only for the 
corresponding configuration variable x„ and each x, is 
controlled independently of the others by a local adapt- 
ive controller. The couplings between the configuration 
variables then appear as “disturbances” and the adapta- 
tion laws are modified slightly to compensate for the 
unmodeled disturbances. The local control scheme for 
the configuration variable x,- is 

FM + Kp t (t)ej 

(O+KMeM+cMXdM+bMXdM + uMXdM ( 2 1 ) 

where e/=xrf/— x/is the tracking error of the ith configu- 
ration variable, and the modified adaptation laws are 

qiU) = W pi e,{t) + w vi e t lt) (22) 

r i ft (23) 

dtit ) = //,<()) - O’, d t {t)dt 4- Si q,\l)dt - r foqiU) 

Jo Jo 

f l (24) 

kpiiO = kpt{0) — 07 I kp,{t)dt 4- 

J 0 

a|, I qjU)L'jU)dt + a2,q,U)ciU) 

J 0 

f ' <25) 

kyi(t) = k vl (0) — 07 I kyj(l)dt 4 

j 0 

P\i I q,{t)e,{i)dt 4- {iiiq t U)e,it) 

Jo 


k pi {t)dt 4- 


,U)dl 4- a2iq,U)cj{t) 


k y/( t ) — A'vA 0) — CTj I k v {(i)dt 4 

J 0 


i B\i j q,it)i'i(l)dl -4 {iijq,{t)e,it) 


c&t) = c,<0) 


f ' 

Ti I C,U 
J 0 


, f v 

J 0 


q,il)xdiiOdt + vnq,it)xd,it) 


bit) = bfi 0) - o', b,it)dt 4- 


f ' 

= a,<0) - crj a,{i 

J 0 


f ' . 

1/ <hiOx di i 

j 0 


71/ q,it)xd,it)dt + ynq t {t)xd,{t) 


f ' 

1/ qt 

J 0 


qM'xdiiOdt 4 X2 MtVYx'diU) 


where cr/is a positive scalar design parameter. Using the 
local control law (21), each end-effector, coordinate y, 
and each kinematic function cf>/ are controlled indepen- 
dently of the remaining configuration variables. The 
decentralized adaptive control scheme (2 1 )— (28) can be 
computed much faster than the centralized control law 
(11)-(18), since the number of mathematical operations 
is reduced considerably due to decentralization. Note 
that although the task-space control law (21) is decen- 
tralized, this property is lost in the transformation from 
task space to joint space T = J' F for implementation, 
since all joint torques must be applied simultaneously to 
control each configuration variable. 
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The centralized and decentralized adaptive control 
schemes presented in this section are extremely simple 
since auxiliary signal and controller gains are evaluated 
from (12)— (18) or (22)-(28) by simple numerical integra- 
tion using, for instance, the trapezoidal rule. Thus the 5 
computational time required to calculated the adaptive 
control law (11) or (21) is extremely short. As a result, 
the scheme can be implemented for on-line control of 
redundant manipulators with high sampling rates; re- 
sulting in improved dynamic performance. This is in 10 
contrast to most existing approaches which require 
time-consuming optimization processes unsuitable for 
fast on-line control implementation. It is important to 
note that the adaptation laws (12)— (18) or (22)— (28) are 
based solely on the observed performance of the manip- 15 
ulator rather than on any knowledge of the complex 
dynamic model or parameter values of the manipulator 
and the payload. We now discuss briefly the implica- 
tions of Jacobian singularities on configuration control. 
Suppose that the transposed augmented Jacobian matrix 20 
J' has n distinct eigenvalues {X|, . . . , A„ }, and n right 
and left eigenvectors {ui, . . . , u*} and {vi, . . . , v rt }, 
respectively, where J'u \ = A,- u,* and v/J' — A/ v, for i = 1 , . 

. ♦ , n, and v,‘,u/, =0 for all i=£j. Then J' can be expressed 
by the modal decomposition form 25 

n 

f — 2 X ,-w/v/. 

/= 1 

hence, the force-torque transformation becomes 

n (29) 

2 (kjVjF)u,'. 
i— l 

35 

It is seen that along each eigenvector u /, the contribu- 
tion of the control force F to the joint torque T is equal 
to (A, v,F)u f *. Now, suppose that Ay=0 for some j; i.e., 
the Jacobian matrix J is singular. Then, any control 
force F in the task-space direction uy will make no con- 40 
tribution to the joint torque T. Thus the ability to con- 
trol the manipulator in a certain taskspace direction is 
impaired. However, the proposed method allows com- 
plete control of the manipulator motion in the remain- 
ing directions for which A / is non-zero; since the corre- 45 
sponding control force F / does not map into zero joint 
torque T. This is in contrast to pseudoinverse-based 
methods requiring inversion of the matrix (J<J' e ) which 
becomes rank-deficient when the end-effector Jacobian 
matrix J e is singular. 50 

The following points are noted about the proposed 
adaptive configuration control scheme: 

(1) By controlling the manipulator directly in task 
space, the complicated and time-consuming inverse 
kinematic computations are not required. This makes 55 
the scheme computationally efficient as a real-time con- 
trol algorithm. 

(2) Since the control problem is formulated in task 
space, the method can be extended readily to hybrid 
force and configuration control, and also to the control 60 
of redundant multi-arm robots. 

(3) Using this dynamic control scheme, accurate 
tracking of desired trajectories for the basic and the 
additional tasks can be achieved simultaneously. Fur- 
thermore, in contrast to local methods based on Jaco- 65 
bian pseudoinverse, the proposed scheme provides di- 
rect control of the manipulator motion over the entire 
trajectory. 
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(4) Redundant manipulators are often composed of 
many joints to enhance their dexterity and versatility 
and will therefore have highly complicated dynamic 
models. When model-based control schemes such as the 
Computed Torque Technique are used, the on-line 
computation of the full dynamic model may make it 
impractical to implement fast control loops. On the 
other hand, adaptive control schemes provide a practi- 
cal alternative, since on-line adaptation eliminates the 
need for the complex dynamic model and thus allows 
fast control loops to be implemented. 

(5) In contrast to pseudoinverse-based methods, the 
proposed approach does not require the assignment of 
priorities to the basic and additional task specifications, 
since the additional task requirements re met indepen- 
dently through the kinematic functions. In other words, 
the performance of the basic task (end-effector motion) 
is not sacrificed due to the presence of the additional 
task (kinematic constraints), provided the task trajecto- 
ries avoid the augmented Jacobian singularities. In our 
formulation, the weighting matrices {W^, W v } are used 
to assign some degree of relative significance to position 
and velocity errors of all task variables. These matrices 
need not be constant throughout the robot motion, and 
can be varied according to the task requirements. 

(6) The proposed formulation provides the capability 
of satisfying multiple objectives through the definition 
of basic and additional task requirements. These re- 
quirements have simple tangible physical interpreta- 
tions in terms of the manipulator configuration, rather 
than abstract mathematical goals. The task require- 
ments are achieved by means of a simple control law 
which can be implemented as real-time algorithm for 
on-line control with high sampling rates. Using the 
proposed formulation, the task to be performed by the 
redundant manipulator can be decomposed into a num- 
ber of subtasks with different kinematic constraints. In 
the execution of each subtask, the appropriate kinematic 
constraint is satisfied, in addition to the specified end- 
effector motion. 

(7) A distinctive feature of the proposed control 
scheme is its applicability to the shared operator- 
/autonomous mode of operation for performing a given 
task. This is due to the fact that the basic task and the 
additional task appear as two distinct and separate enti- 
ties in the proposed control scheme, as shown in FIG. 3. 
The present formulation allows the operator to specify 
the basic task of desired end-effector motion using an 
input device such as a hand controller. The autonomous 
system can then invoke the AI spatial planner to specify 
the additional task of desired kinematic constraints that 
will be performed simultaneously through the utiliza- 
tion of redundancy. In this way, the operator and the 
autonomous system can share the execution of a com- 
plex task. 

IV. Special Case: Kinematic Optimization 

In this section, the configuration control scheme is 
used to optimize any desired kinematic objective func- 
tion. 

Let g(0) denote the scalar kinematic objective func- 
tion to be optimized by the utilization of redundancy. In 
order to optimize g (0) subject to the end-effector con- 
straint Y = Jc>0, we apply the standard gradient projec- 
tion optimization theory to obtain the optimality crite- 
rion for the constrained optimization problem as 
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where J e +=J' e (J^J'*,) is the pseudoinverse of 3 e . The 5 
nxn matrix (I — J e J' e )~ l is of rank r and therefore (30) 
reduces to 


where N e is an rXn matrix formed from r linearly inde- 
pendent rows of (I— J e + J e ) is symmetric. The rows of 
N e span the r-dimensional null-space of the end-effector 
Jacobian J e , since J e (I— J e +J e )=0 and (I— 3 e ) is 15 

symmetric. Equation (31) implies that the projection of 
the gradient of the objective function g(0) onto the 
null-space of the end-effector Jacobian matrix J^must be 
zero. This is the result used by Baillieul [7]-[ll] in the 
extended Jacobian method. Using the configuration 20 
control approach, we define the r kinematic functions as 


and the desired trajectory as <t>^t)=0 to represent (31). 
Therefore, the configuration vector X and the aug- 
mented Jacobian matrix J are now 


30 




The adaptive control scheme of Section III can now be 
applied directly to ensure that X(t) tracks the desired 
trajectory 

45 
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the distance between the object and the closest robot 
link should exceed a certain threshold, which leads to 
an inequality constraint. Similarly, inequality con- 
straints can represent avoidance of joint limits and kine- 
matic singularities. 

The formulation of the configuration control scheme 
allows kinematic inequality constraints to be incorpo- 
rated directly into the control law. For instance, sup- 
pose that the additional task requires the inequality 
constraint <f>/ (0) ^ c where c/ is some constant, to be 
satisfied by the kinematic function <j)/. Then, for <f>,{0) 
<c /, the tracking errors are defined as e/=c/ — d> # * (0) 
and e/=0 — <f>/ (0); while for cf>,- (0) =c/ we have e,_ 
= e/=0. Therefore, we can choose <f>^/ (t) = 4>^(t)==- 
<f><tf(t) = 0 and use the adaptive feedback control law 
F/— di+kpiei + k V iei to achieve the additional task re- 
quirement. 

VI. Joint-Based Configuration Control 

The configuration control scheme described in Sec- 
tion III is “task-based,” in the sense that the tracking 
errors are formed and the control actions are generated 
in the task space. In some applications, it is preferable to 
use a joint-based control system, for instance, to com- 
pensate joint frictions more effectively. In this section, 
we describe briefly the implementation of the configu- 
ration control scheme in a joint-based robot control 
system. 

For joint-based control, we first need to determine 
the nX 1 desired joint angular position vector 0^(t) that 
corresponds to the n X 1 desired configuration vector 
X^t). This can be done by solving the augmented in- 
verse kinematic equations pertaining to the manipula- 
tor. The inverse kinematic solution produces a finite set 
of joint angles with distinct poses, and often the solution 
corresponding to the initial pose is selected. Alterna- 
tively, the differential kinematic equations can be solved 
recursively using the augmented Jacobian. The Jaco- 
bian approach can be computationally more efficient 
than the inverse kinematic solution, and can also be used 
when there is no closed-form analytical solution to the 
inverse kinematic problem, e.g., for robots with non- 
spherical wrists. 

Once the desired joint trajectory 0</(t) is computed, it 
is used as a setpoint for the joint servo-loops. A joint- 
based control scheme can be employed to achieve tra- 
jectory tracking in joint space. The adaptive joint con- 
trol law is given by 


Therefore, we have shown that the kinematic optimiza- 
tion problem can be reformulated as a special case of the 
configuration control problem, and the proposed solu- 
tion does not require the complicated inverse kinematic 
transformation. 55 

It must be noted that for a general objective function 
g(0), (30) is only a necessary condition for optimality, 
and not a sufficient condition. As a result, the satisfac- 
tion of the kinematic constraint (31) does not always 
represent a truly optimal solution. 60 

V. Inequality Constraints 

In Section III, the additional task to be performed is 
formulated as the trajectory tracking problem 
0(0) = (|> rf (t). In some applications, however, the addi- 
tional task requirements are expressed naturally as a set 65 
of kinematic inequality constraints <J> (0) = C, where C 
is a constant vector. For instance, when the redundancy 
is utilized to avoid collision with a workspace object, 


7 \t) = d(t) + [K p (t)E(t) + KJt)E(t)\ + [CU)0 (J (t) + Bit)- 
0dU) + A(t)O d (t)] 

For practical implementation .of the control schemes 
discussed so far, we require the capability of sending the 
control torques computed by the controllers directly to 
the joint motors. In some applications, the joint servo- 
loops provided by the robot manufacturer cannot be 
modified easily to accept torque commands. In such 
cases, the desired joint trajectories 0<y(t) computed from 
the inverse kinematics or Jacobian are simply sent as 
setpoints to the joint servo-loops, which ensure that 
trajectory tracking is achieved. 

VII. Cyclicity of Motion 

Robot manipulators are often employed in repetitive 
operations. For greater efficiency and reliability, it is 
highly desirable that at the end of each operation cycle 
the robot returns to the same configuration. This prop- 
erty is known as “cyclicity” of motion. For a redundant 
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robot, it is possible for the end-effector to return to the 
same task space position and yet the robot to be in a 
completely different configuration. In fact, this is gener- 
ally the result obtained when methods based on Jaco- 
bian pseudoinverse are used to control the robot mo- 5 
tion. 

The configuration control approach has the attrac- 
tive feature of cyclicity of motion, since through defini- 
tion of the n configuration variables {xi, . . . , x„}, the 
kinematic representation of the manipulator is no longer 10 
redundant. Therefore, it can be viewed as a non-redun- 
dant manipulator which, in general, possesses the prop- 
erty of cyclicity, provided the singularity boundaries 
are not crossed. In other words, when the configuration 
variables traverse a closed path in task space, the joint 15 
angles will, in general, traverse a unique closed curve in 
joint space, and hence the initial and final manipulator 
configurations will be identical. Therefore, the configu- 
ration control scheme meets the essential requirement 
of cyclicity for repetitive operations. 20 

VIII. Implementation of Configuration Control Scheme 

In this section, we discuss the experimental results of 
three links of an industrial robot using the configuration 
control scheme. 

The testbed facility at the JPL Robotics Research 25 
Laboratory consists of a six-jointed Unimation PUMA 
560 robot/controller, and a DEC Micro VAX II com- 
puter, as shown in the functional diagram of FIG. 5 . A 
cylindrical aluminum “link” has been fabricated and 
attached to the PUMA wrist as shown in FIG. 5 , so that 30 
the end-effector can be mounted at the end of the link. 
The link acts as an extension for the PUMA robot. By 
activating the shoulder joint 02, the elbow joint 03, and 
the wrist joint 05, the upper-arm, forearm, and the extra 
link move in a vertical plane, and hence the pUMA 35 
robot can operate as a redundant 3-link planar arm. 

The MicroVAX II computer hosts the RCCL (Robot 
Control “C” Library) software, which was originally 
developed at Purdue University and subsequently modi- 
fied and implemented at JPL. The RCCL creates a “C” 40 
programming environment in which the user can write 
his own software for a trajectory generator and a con- 
trol algorithm to directly control the robot motion. The 
MicroVAX communicates with the Unimation control- 
ler through a high-speed parallel link. During the opera- 45 
tion of the robot, a hardware clock constantly interrupts 
the I/O program resident in the Unimation controller at 
the preselected sampling period of T s =7 ms (i.e., 
f s = 143 Hz), which is the lowest sampling period avail- 
able in the present experimental setup. At every inter- 50 
rupt, the I/O program gathers information about the 
state of the robot (such as joint encoder readings), and 
transmits these data to the control program in the Mi- 
croVAX. The I/O program then waits for the control 
program to issue a new set of control signals, which are 55 
then dispatched to the appropriate joint motors. There- 
fore, the MicroVAX acts as a digital controller for the 
PUMA robot and the Unimation controller is effec- 
tively by-passed and is utilized merely as an I/O device 
to interface the MicroVAX to the PUMA joint motors. 60 

To test and evaluate the configuration control 
scheme of the present invention, the proposed control- 
ler is implemented on the three joints [02, 03, 0s] of the 
PUMA 560 robot; while the remaining three joints [0i, 

04, 06] are held at their zero positions. For clarity of 65 
presentation, the three coplanar links of PUMA, 
namely, upper-arm (lj=432 mm), forearm (1 2 = 433 
mm), and the extra link (13 = 577 mm) are redrawn in 
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FIG. 6 to form a 3-link planar arm, and the offset be- 
tween upper-arm and forearm is ignored. The base co- 
ordinate frame (x, y) is then assigned to the planar arm 
as shown in FIG. 7, with the origin coinciding with the 
shoulder joint. The joint angles ii/2, d/3] are defined 
as “absolute" angles between the links and the positive 
x direction; hence in terms of the PUMA relative angles 
(0 2 , 03, 0s) measured from the PUMA zero position we 
have = — 0 2 , 1)12— —02 — 03 + 90% and d/3 = — 02 — 
05 + 90°. The problem is to control the Cartesian coordi- 
nates [x, y] of the endpoint (tip of the extra link) in the 
base frame as the basic task, together with controlling a 
user-specified kinematic function d> which defines and 
appropriate additional task. The set [x, y, d>] then de- 
fines the configuration vector of the 3-link planar arm. 
The control scheme is implemented in a decentralized 
structure in task space, where each configuration vari- 
able is controlled independently by a simple feedback 
controller with adaptive gains. 

Two different choices for the additional task variable 
( f> will be considered. In the first case, d> is chosen in 
joint space as the shoulder angle; while, in the second 
case, <f> is defined in Cartesian space as the wrist height. 

Case (i)-Control of Shoulder Angle: In this case, we 
wish to use the redundancy to control the shoulder 
angle \i/ 3 . The shoulder joint requires the highest torque 
to cause motion, since the inertia of the whole arm is 
reflected back to the shoulder. Therefore, by control- 
ling U/ j directly, we attempt to keep the largest joint 
torque under control. It is noted that in this case, the 
3-link manipulator can be viewed as a 2-link arm (1 2 , I3) 
mounted on a moveable base. Therefore, by slow base 
motion and fast endpoint movement, we can achieve 
fast manipulation with low torques. 

Referring to FIG. 6, the configuration variables and 
the augmented Jacobian matrix are given by 

*(0 = /| cos iiu(r) -l- h cos dnU) 4 - h cos 

=■ sin -f li sin i!n(0 + 0 sin 

r -1 (54) 

— 1\ sin ii/| —h sin *ln — h sin iin 

J = l) cos U/| h cos 1 in h cos iJm 

_ 1 0 0 

The singular configurations of the arm are obtained 
from 

det\J\ — — — ^ 3 ). 

Hence, the arm is at a singularity when ii>2 = d/3 or 
ijj2=vJ/3 + 180°, i.e., links 2 and 3 are aligned. These can 
be recognized as the classic singularities of the two-link 
arm (1 2 , I3)* 

In the experiment, the initial configuration of the 
three-link, arm is chosen as t///i=0°, i|/g = 90°, and 
= 45°. This results in the initial values of the configu- 
ration variables obtained from (53) as (xj, y/, 6,) = (839 
mm, 842 mm, 0°). The desired final values of the config- 
uration variables are specified as (xy; y y; d/y) = ( 1 1 00 mm, 
600mm, 60°). The desired transition from the initial to 
the final values is described by the smooth cycloidal 
trajectories 

( 55 ) 
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-continued 


Xd(t) = 839 + 


1100 - 839 
2v 


= 1 100 mm. 


I 2nt ■ 27 rt 


mm, 0=/=3 


3<r 
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Furthermore, we ignore the dynamics of the joint mo- 
tors by assuming that the demanded and the generated 
joint torques are always equal. 

In the experiment, the adaptation gains in (57)— (60) 
are chosen after a few trial and errors as 


j VdiO = 842 + 

= 600 mm, 


600 - 842 
27T 


<M 0 


[ 277 -t . 27 rt I < 

— - — _ sm — - — I mm. 0^ r= 

3<r 

„ . 60 — 0 r 2irt 2nt "1 , ^ , 

= 0 + — " — -y - sin— j— deg, 0 = f^3 


w px = 50 w w 


30 Wpy = 10 Wyy = 10 


10 


Wp<b = 40 Wytb — 20 


= 60*, 


3<r 
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and the transition time is 3 s. Note that the desired path 
for the endpoint is a straight line, since from the above 
equations we have 


x d - 839 
1100 - 839 


yd - 842 
600 - 842 
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81 * = 50. Siy = 40. Sid, — 50. 82 i = 0, for / — xv.cf) 
aj x — 100 , aj v = 100 . aid, — 100 , a 2/ = 0 . for i — x.y.(b 
P\ x = 200 . /3i v — 200 . ^3 id, = 800. / hi — 0 . for i — x.y.S. 

These values do not represent the “optimum” settings 
of the adaptation gains that can be chosen for the exper- 
iment. The initial values of the controller terms are 
chosen as follows: 

kpi{0) = 0 , / = x.y.<b 
k vx ( 0 ) = 80 k vv ( 0 ) = 20 A'vd,( 0 ) = 0 


The configuration variables [x, y, <j>] are controlled 
by three independent adaptive feedback control laws of 
the general form 

Flit) = d t {t) + KptiOeit) + KMe l it)c l it)j=x.y. (56) 
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/ d x (0) N 
d/0) 

dm 


= {fW\- 


T\( 0 ) 

r 2 ( 0 ) 


^ 3 sgn (a-^3) - x( 0 ) ] 
0 

^ 10 sgn (<M3) - d>(0)] 


as shown in the block diagram of FIG. 7, where the 
feedforward terms are omitted to reduce the on-line 30 
computation time. In (56), F is the task-space control 
force, d is the auxiliary signal, (k^, k v ) are the position 
and velocity feedback gains, and (e, e) are the position 
and velocity errors; e.g., e x =\d— x and e x 32 x^— x. The 
current values of the configuration variables are com- 35 
puted from the joint angles using the augmented for- 
ward kinematic model (53). The terms in the control 
law (56) are updated on the basis of the weighted error 
q/<t) as 


40 


q&t) - w pi e t it) + w V[ e,it) 


d£t) = dm + 81/ 


q t it)dt + 82 iq,it) 


,, r '« 

J 0 

kpi(t) = k p m + a\j I q£t)e£f)dt 4- a 2 tfX')e,<0 

Jo 

kviit) = M0) 4- 0]j I q&t)eKt)dt + 0 2 iq,{t)e ( {t). 

J 0 


(57) 

(58) 


45 


(59) 


(60) 


50 


It is noted that, from (57), (58), the control law (56) can 
alternatively be rewritten in the PID form 


F t {t) = F,i 0) -j- k p ,it)e,it) + k vi (t)e,it) + k fl 


V J e,it)dt. 

J 0 


55 


(61) 


Once the task-space control forces [F*, F^,, F^] are gen- 
erated by the controllers in (56) or (61), the required 60 
joint control torques [Ti, T 2 , T 3 ] are obtained from 




(62) 


where J is the 3x3 augmented Jacobian matrix given in 65 
(54). It must be noted that the controller equations 
(56)-(60) are implemented in RCCL in discrete form, 
with the integrals computed by the trapezoidal rule. 


where (Ti(0), T 2 (0), T 3 (0)) are the initial joint torques 
used to approximately compensate for the initial gravity 
loading, and the sign terms are chosen empirically to 
overcome the large stiction (static friction) present in 
the joints. The initial gravity torque for the third link is 
given by 


73 ( 0 ) = y mig cos ii/ 3 ( 0 ) — 0.8844 cos ii/ 3 ( 0 ) 


where m 3 = 0.3125 kg; and the initial gravity torques for 
the first and second links are 

7*i (0) — 8.4coAln(0) 4 - ll.lcostf) \ (0) 4 - 1 .02sitt ii> \ (0) 

7* 2 (0) = 8.4cosi/i 2 (0) —0.2 5 sin ii* 2 (0 ). 

It is important to note that although the arm is moving 
in the vertical plane with large joint frictions, gravity 
and friction compensations are not used separately in 
addition to the control law (56), and are used merely as 
the initial auxiliary signal in order to improve the initial 
response of the arm. 

In the experiment, the configuration variables [x(t), 
y(t), (f> (t)], representing the endpoint coordinates and 
the shoulder angle, are commanded to change simulta- 
neously from the initial to the final values in 3 s by 
tracking the desired cycloidal trajectories of (55). Dur- 
ing the arm motion, the joint encoder counts are re- 
corded and transformed using (53) to obtain the values 
of the configuration variables. FIGS. 8 , 9, and 10 show 
the desired and actual trajectories of the configuration 
variables. It is seen that each variable [x(t), y(t), 6 (t)] 
tracks the corresponding reference trajectory closely 
using the simple decentralized control scheme of (56), 
despite the coupled non-linear robot dynamics. Some 
discrepancy is observed between [x(t), y(t)] and [x<j (t), 
Yd (t)] at low speed of endpoint motion which can be 
interpreted physically as follows. When the endpoint is 
moving at low speed, the joint angles are changing very 
slowly, and hence the stiction and Columb friction pres- 
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ent in the joints become more dominant and oppose the 
motion, causing a slight tracking error. Since the posi- 
tion and velocity tracking error e(t) and e(t) are very 
small, the rate of adaptation of the controller terms 
[d(t), k^ (t), kv(t)] are also small. In this situation, it is 5 
primarily the output of the integral term 

K\fedt 

that needs to build up sufficiently so as to overcome the io 
large friction and cause proper joint motion to correct 
the error. 

Case (ii) Control of Wrist Height: In this case, the 

redundancy is used to control the vertical coordinate of 
the wrist. This is a suitable additional task in situations 15 
where we wish to avoid collision with a vertical obsta- 
cle, such as a wall, in the workspace. By controlling the 
wrist height, we ensure that the arm can go over the 
wall and the endpoint can reach a point behind the wall. 
This can provide a simple alternative approach to the 20 
more complicated obstacle avoidance schemes. 

As in Case (i), the initial joint angles are =0°, 

\p t 2 =90% \j/i3=45 c ; yielding the initial arm configuration 
variables as (x„ y/, 4> f j=(839mm, 842mm, 433mm). It is 
desired to change the arm configuration variables in 3 s 25 
to the final values (x/, y/, 4>/)=(1000 mm, 500 mm, 700 
mm) by tracking the following cycloidal reference tra- 
jectories: 

(65) 30 


*d(r) 

- 839 + 1000 - 839 

2 77/ 
3 

- sin 

1 1 

mm. 

0=/^§ 3 


= 1000 mm, 
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- 842 + 500 " 842 
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2?J7 

3 

— sin 
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3<! 

M0 
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r 2 71/ 
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— sin 
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= 700 mm, 





3</. 

Note 

: that this yields a straight-line path 

for 

the end- 

point, since we have 







Xd — 839 yd — 
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1000 - 839 500 - 842 


The three configuration variables [x, y, <j>] are con- 
trolled using three independent adaptive feedback con- 
trollers as described in Case (i) and shown in FIG. 7. 
After a few trial and errors, the adaptation gains are 55 
chosen as 

w px — 90 W yx — “ 25 VV py — — 15 

W V y — 20 Wpfo = 30 >Vy^ ~ 60 ^ 

Si* = 120, 8iy = 60, 8)6 = 200, 82/ — 0, for i — x,y,(b 
a\ x = 200, a\ y — 100, ai<f, = 100, cn / = 0, for i = x.y . 6 

P\ x — 200, P\y = 200, j3]<!) — 200, &u — 0, for / — x,y,<&. 

The initial values of the controller gains are selected as 55 


k pi ( 0) - 0, / = x.y.6 
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-continued 

k vx = 130 k vv = 30 A-V6 ~ 400 

and the initial auxiliary signals are chosen as in Case (i) 
with the friction coefficients [3, 0, 40]. 

In the experiment, we command the configuration 
variables [x(t), y(t), (j> (t)], representing the endpoint 
coordinates and the wrist height, to change from the 
initial to the final values in 3 s by tracking the desired 
cycloidal trajectories (65). FIGS. 11 , 12 and 13 show 
the desired and actual trajectories of the configuration 
variables, and illustrates that each variable tracks the 
corresponding reference trajectory closely using a sim- 
ple decentralized control scheme. There is a slight 
tracking error of joint friction at low speed of motion. 
In other words, when the endpoint and wrist are mov- 
ing slowly, the velocities of joint angles are so low that 
the friction effects dominate until the controller torques 
overcome the frictions and corrective actions are taken. 

Finally, it is important to note that in both Cases (i) 
and (ii), by increasing the rate of sampling from f v = 143 
Hz to say f 9 =1000 Hz, considerable improvement is 
expected in the tracking performance of the controllers. 
However, the present experimental setup cannot oper- 
ate faster than f 5 =143 Hz. Furthermore, the PUMA 
robot has very large static and Columb frictions, and 
better results are expected with an inner-loop friction 
compensation. Nonetheless, given the limitations of the 
present experimental setup, it is believed that the experi- 
mental results demonstrate the capabilities of the con- 
figuration control scheme of the present invention and 
validate the scheme in a realistic environment. 

CONCLUSIONS 

It will now be understood that a simple formulation 
for configuration control of redundant manipulators has 
been developed. The controller achieves trajectory 
tracking for the end-effector directly in the Cartesian 
space to perform some desired basic task. In addition, 
the redundancy is utilized by imposing a set of kine- 
matic constraints on the manipulator to accomplish an 
appropriate additional task. The proposed formulation 
incorporates the kinematic constraints (additional task) 
and the end-effector motion (basic task) in a conceptu- 
ally simple and computationally efficient manner to 
resolve the redundancy. Furthermore, the adaptive 
controller has a very simple structure and the controller 
gains are updated in a simple manner to compensate for 
changing dynamic characteristics of the manipulator. 
The adaptation laws are based on the observed perfor- 
mance of the manipulator rather than on any knowledge 
of the manipulator dynamic model. Thus the adaptive 
controller is capable of ensuring a satisfactory perfor- 
mance when the payload mass is unknown and time- 
varying. Any approach used to resolve redundancy 
should be implementable as a real-time algorithm, and 
therefore the speed of computation is a critical factor. 
The small amount of computations required by the 
proposed method offers the possibility of efficient real- 
time control of redundant manipulators. 

It is important to appreciate the difference between 
the conventional pseudoinverse-based methods and the 
configuration control scheme. Pseudoinverse-based 
methods resolve the redundancy at the velocity level 
and yield local optimization results. In the configuration 
control scheme, the redundancy is resolved at the posi- 
tion (i.e., task) level to provide direct control over the 
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entire motion. Furthermore, pseudoinverse-based meth- 
ods do not generally produce cyclic motion of the ma- 
nipulator, which is an essential requirement for repeti- 
tive operations; whereas the proposed scheme ensures 
cyclicity. It is also important to distinguish between the 5 
extended Jacobian method and the method of the pres- 
ent invention. The extended Jacobian method is con- 
cerned with solving the inverse kinematic problem for 
redundant robots by extending the end-effector Jaco- 
bian to include an optimization subtask, assuming the 
initial robot configuration is optimal. The present inven- 
tion, however, provides a dynamic control scheme for 
redundant manipulators based on any desired task aug- 
mentation, without requiring the inverse kinematic so- 
lution. It is also shown that the extended Jacobian 15 
method can be treated as a special case of the configura- 
tion control scheme. It is observed that when optimiz- 
ing an objective function in joint space, the variation of 
the manipulator configuration in task space is not con- 
trolled directly, and this may lead to undesirable mo- 20 
tions of the manipulator. 

Those having skill in the arts relevant to the present 
invention, will now perceive variations and additions to 
the invention based upon the preferred embodiment ^ 
disclosed herein. Thus, it will be understood that the 
invention is not to be limited to the disclosed embodi- 
ment, but is to be deemed to be limited only by the 
scope of the claims appended hereto. 

I claim: 30 

1. An apparatus for controlling a redundant robot; the 
apparatus comprising: 

means for defining a set of end-effector coordinates 
corresponding to a basic task motion of said robot; 

means for defining a set of kinematic functions corre- 35 
sponding to an additional task motion capability 
available as a result of the redundancy of said ro- 
bot; 

means for combining said set of coordinates and said 
set of functions to form a set of task-related config- 40 
uration variables as generalized coordinates for 
control of said robot; and 

means for dynamically modifying said configuration 
variables in accordance with a task-based adaptive 
scheme for tracking at least one reference trajec- 45 
tory during robot motion. 

2o The apparatus recited in claim 1 wherein said 
means for defining said set of kinematic functions com- 
prises means for defining said set of functions in Carte- 
sian space. 50 

3. The apparatus recited in claim 1 wherein said 
means for defining said kinematic functions comprises 
means for defining said set of functions in joint space. 

4. The apparatus recited in claim 1 wherein said addi- 
tional task motion is based on kinematic equality con- 55 
straints. 
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5. The apparatus recited in claim 1 wherein said addi- 
tional task motion is based on kinematic inequality con- 
straints. 

6. The apparatus recited in claim 1 wherein said 
adaptive scheme is centralized. 

7. The apparatus recited in claim 1 wherein said 
adaptive scheme is decentralized. 

8. The apparatus recited in claim 1 wherein said 
means for dynamically modifying operates in essentially 
real time. 

9. The apparatus recited in claim 1 wherein said end- 
effector coordinated-defining means is operator con- 
trolled. 

10. The apparatus recited in claim 9 wherein said 
kinematic-function-defining means is autonomously 
controlled during said operator control of said end- 
effector coordinate-defining means. 

11. A method for controlling a redundant robot; the 
method comprising the steps of: 

(a) defining a set of end-effector coordinates corre- 
sponding to a basic task motion of said robot; 

(b) defining a set of kinematic functions correspond- 
ing to an additional task motion capability available 
as a result of the redundancy of said robot; 

(c) combining said set of coordinates and said set of 
functions to form a set of task-related configuration 
variables as generalized coordinates for control of 
said robot; and 

(d) dynamically modifying said configuration vari- 
ables in accordance with a task-based adaptive 
scheme for tracking at least one reference trajec- 
tory during robot motion. 

12. The method recited in claim 11 wherein step (b) 
further comprises the step of defining said set of func- 
tions in Cartesian space. 

13. The method recited in claim 11 wherein step (b) 
further comprises the step of defining said set of func- 
tions in joint space. 

14. The method recited in claim 11 wherein step (b) 
further comprises the step of basing said additional task 
motion on kinematic equality constraints. 

15. The method recited in claim 11 wherein step (b) 
further comprises the step of basing said additional task 
motion on kinematic inequality constraints. 

16. The method recited in claim 11 wherein in step (d) 
said adaptive scheme is centralized. 

17. The method recited in claim 11 wherein in step (d) 
said adaptive scheme is decentralized. 

18. The method recited in claim 11 wherein step (d) is 
carried out in essentially real time. 

19. The method recited in claim 11 wherein step (a) is 
performed under the control of an operator. 

20. The method recited in claim 19 wherein step (b) is 
performed autonomously while step (a) is performed 

under said operator control. 

* * * * * 
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